#include "POWER.h"
#include "lcd.h"
#include "main.h"
#include <stdio.h>
#include <string.h>

void power_init()
{
  while(HAL_GPIO_ReadPin(POW_ENI_GPIO_Port,POW_ENI_Pin))
    {

    };
}


void power_scan(float vbat)
{
  if(HAL_GPIO_ReadPin(POW_ENI_GPIO_Port,POW_ENI_Pin))
    {
      HAL_GPIO_WritePin(LCD_LED_GPIO_Port,LCD_LED_Pin,0);
      while(HAL_GPIO_ReadPin(POW_ENI_GPIO_Port,POW_ENI_Pin)) {};
      HAL_Delay(300);
      HAL_GPIO_WritePin(POW_EN_GPIO_Port,POW_EN_Pin,0);
      HAL_Delay(300);
      HAL_NVIC_SystemReset();
    };
//  if(vbat<3.1)
//    {
//      HAL_Delay(10);



//      LCD_Clear(BLACK);
//      LCD_ShowString(120,112,(uint8_t *)"LOW POWER!",WHITE,BLACK);

//      char str[32];

//      uint16_t ir_buf[240*320];
//      sprintf(str,"BAT:%4.2fV",vbat);
//      vram_showstring(320-strlen(str)*8,16,(uint8_t *)str,WHITE,BLACK,16,0,ir_buf,320,240);


//      HAL_Delay(3000);
//      HAL_GPIO_WritePin(POW_EN_GPIO_Port,POW_EN_Pin,0);
//      HAL_Delay(300);
//      HAL_NVIC_SystemReset();
//    }
	
}